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AMENDMENTS TO THE CLAIMS : 

This listing of claims replaces all prior versions and listings of claims in the 
application: 

LISTING OF CLAIMS : 

1 . (Currently Amended) A method of planning at least one path for a vehicle an object in 
a state space from a starting position to a goal position to avoid a plurality of static and/or 
dynamic objects, comprising: 

(a) associating predetermined attributes with the plurality of static objects and/or the 
plurality of dynamic objects located in the state space, the state space being a probability space; 

(b) generating a probabilistic tree in the state space including a plurality of branches 
extending from the starting position of the vehicle towards the goal position located in the state 
space; and 

(c) extending the plurality of branches of the probabilistic tree towards the goal position 
located in the state space based on a plurality of random tree extension rules and a plurality of 
deterministic tree extension rules until satisfying a predetermined stopping condition , the 
deterministic tree extension rules comprising: 



a first deterministic rule to add a linear path: and 
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a second deterministic rule to extend the linear path by adding a turn such that at 
the end of the turn the vehicle is on a new heading that is closer to obtaining the goal 
position ; and 

(d) evaluating at least a first branch of the plurality of branches of the probabilistic tree 
for determining whether the first branch of the plurality of branches of the probabilistic tree 
satisfies predetermined trajectory path constraints. 

2. (Original) The method of claim 1, wherein if the first branch of the plurality of 
branches of the probabilistic tree conforms to the predetermined trajectory path constraints, the 
method further includes: 

(e) declaring the first branch of the plurality of branches of the probabilistic tree as the at 
least one preferred trajectory path for the vehicle in the state space; and 

(f) controlling the vehicle to follow the at least one preferred trajectory path in the state 
space for moving the vehicle from the starting position towards the goal position in the state 
space. 

3. (Original) The method of claim 2, wherein if the first branch of the plurality of 
branches of the probabilistic tree fails to conform to the predetermined trajectory path 
constraints, the method further includes: 

(g) extending the plurality of branches of the probabilistic tree further based on the at 
least one of the plurality of random tree extension rules and the plurality of deterministic tree 
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extension rules until at least one branch of the plurality of branches of the probabilistic tree 
satisfies the predetermined stopping condition and conforms to the predetermined trajectory path 
constraints. 

4. (Original) The method of claim 3, further including: 

(h) declaring the at least one branch of the plurality of branches of the probabilistic tree 
that couples the starting position to the goal position and that conforms to the predetermined 
trajectory path constraints as the at least one preferred trajectory path for the vehicle in the state 
space; and 

(i) controlling the vehicle to follow the at least one preferred trajectory path in the state 
space for moving the vehicle from the starting position towards the goal position in the state 
space. 

5. (Original) The method of claim 4, further including: 

0) repeating one or more of steps (a)-(i) at predetermined time intervals as the vehicle 
moves along the at least one preferred trajectory path toward the goal for updating the at least 
one preferred trajectory path to compensate for motion of the plurality of dynamic objects. 

6. (Original) The method of claim 1, wherein satisfying the predetermined stopping 
condition includes at least one of satisfying a predetermined time constraint and satisfying a 
predetermined travel distance constraint. 
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7. (Original) The method of claim 1, wherein associating predetermined attributes with 
the plurality of static objects and the plurality of dynamic objects located in the state space 
includes associating at least one of a position value, a velocity value, a direction value, an 
acceleration value and a time value. 

8. (Original) The method of claim 1, wherein generating the probabilistic tree in the state 
space further includes: 

extending each of a first plurality of edges a first predetermined distance and direction 
from the starting position in the state space to each of a corresponding first plurality of nodes 
based on the plurality of random tree extension rules and the plurality of deterministic tree 
extension rules for forming first segments of each of the plurality of branches of the probabilistic 
tree. 

9. (Original) The method of claim 8, further including: 

extending at least one of a next successive plurality of edges from each of the first 
plurality of nodes a second predetermined distance and direction in the state space to each of a 
corresponding next successive plurality of nodes based on the plurality of random tree extension 
rules and the plurality of deterministic tree extension rules for forming next 

successive segments of each branch of the plurality of branches of the probabilistic tree. 
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10. (Original) The method of claim 9, further including: 

repeating cyclically extension of each branch of the plurality of branches of the 
probabilistic tree until at least the first branch of the plurality of branches of the probabilistic tree 
satisfies the stopping condition. 

1 1 . (Original) The method of claim 1 0, further including: 

evaluating whether extension of one or more branches of the plurality of branches of the 
probabilistic tree violate object avoidance constraints; and 

suspending further extension of the one or more branches of the plurality of branches if a 
determination is made that extension of the one or more branches of the plurality of branches of 
the probabilistic tree violate the object avoidance constraints. 

12. (Currently Amended ) A method of planning at least one path for a vehicle an object 
in a state space from a starting position to a goal position to avoid a plurality of static and/or 
dynamic objects, comprising: 

associating predetermined attributes with the plurality of static objects and/or the 
plurality of dynamic objects located in the state space; 

generating a probabilistic tree in the state space including a plurality of branches 
extending from the starting position of the vehicle towards the goal position located in the state 
space, generating the probabilistic tree in the state space comprises extending each of a first 
plurality of edges a first predetermined distance and direction from the starting position in the 
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state space to each of a corresponding first plurality of nodes based on the plurality of random 
tree extension rules and the plurality of deterministic tree extension rules for forming first 
segments of each of the plurality of branches of the probabilistic tree; 

extending the plurality of branches of the probabilistic tree towards the goal position 
located in the state space based on at least one of a plurality of random tree extension rules and a 
plurality of deterministic tree extension rules until satisfying a predetermined stopping condition; 

evaluating at least a first branch of the plurality of branches of the probabilistic tree for 
determining whether the first branch of the plurality of branches of the probabilistic tree satisfies 
predetermined trajectory path constraints. 

extending at least one of a next successive plurality of edges from each of the first 
plurality of nodes a second predetermined distance and direction in the state space to each of a 
corresponding next successive plurality of nodes based on the plurality of random tree extension 
rules and the plurality of deterministic tree extension rules for forming next successive segments 
of each branch of the plurality of branches of the probabilistic tree; 

repeating cyclically extension of each branch of the plurality of branches of the 
probabilistic tree until at least the first branch of the plurality of branches of the probabilistic tree 
satisfies the stopping condition; 

evaluating whether extension of one or more branches of the plurality of branches of the 
probabilistic tree violate object avoidance constraints; 
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suspending further extension of the one or more branches of the plurality of branches if a 
determination is made that extension of the one or more branches of the plurality of branches of 
the probabilistic tree violate the object avoidance constraints; and 

resuming extension of the one or more branches of the plurality of branches if a 
determination is made that extension of the one or more branches of the plurality of branches of 
the probabilistic tree no longer violates the object avoidance constraints. 

13. (Original) The method of claim 1 , wherein extending the plurality of branches of the 
probabilistic tree based on the plurality of random tree extension rules includes at least one of 
extending each branch into the state space that is void of the plurality of static objects and the 
plurality of dynamic objects and extending each branch into the state space that is void of other 
branches of the plurality of branches of the probabilistic tree. 

14. (Currently Amended) The method of claim 1 [[,]] wherein the first deterministic rule 
to add a linear path comprises a rule to add a linear path such that a heading and speed of the 
vehicle are constant extending the plurality of branches of the probabilistic tree, hnr.ed on th^ 
plurality of detenninistic tree extension rules includes at least one of extending each branch 
towards the goal and extending each branch in a straight line with respect to a previous extension 
of each branch . 
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15. (Original) The method of claim 1 , wherein determining whether the first branch of 
the plurality of branches of the probabilistic tree satisfies the predetermined trajectory path 
constraints includes determining whether the first branch of the plurality of branches of the 
probabilistic tree satisfies at least one of a maximum travel distance value, a maximum turn 
angle value, a minimum distance value to the plurality of static objects and the plurality of 
dynamic objects. 



16. (Currently Amended) A path planning method for a vehicle, comprising: 
defining a state space including an initial start position and a goal position, the state space 
being a probability space; 

generating a plurality of paths from the start position to the goal position over 
time on a node by node basis based upon a set of rules comprising a deterministic rale 
rules , a randomness rale rales , and a probabilistic rale rales, the deterministic rales 
comprising: 

a first deterministic rule to add a linear path such that a heading and speed of the 
vehicle are constant; and 

a second deterministic rule to extend the linear path by adding a turn such that at 
the end of the turn the vehicle is on a new heading that is closer to obtaining the goal 
position ; 

assigning locations to objects in the state space over time based upon respective 
probability distributions; and 
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selecting a first one of the generated plurality of paths. 

17. (Original) The method according to claim 16, further including terminating ones of 
the plurality of paths that are not feasible at a given node in the state space. 

18. (Original) The method according to claim 17, further including terminating paths 
based upon one or more of impact with an object, region avoidance, g- force limitations, sensor 
information, path distance, path time, number of turns, altitude change limitations, straight path 
desirability, object location confidence level, turning radius limitations, and turning penalties. 

19. (Original) The method according to claim 16, further assigning a confidence level to 
object locations. 

20. (Original) The method according to claim 16, further including assigning object 
state information including one or more of position, heading, velocity, acceleration, turning 
radius, acceleration limit, velocity limit, g-force limit, and location confidence level. 

21 . (Original) The method according to claim 20, further including assigning a 
probability distribution to one or more components of the object state information. 
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22. (Currently Amended) A method of adaptive path planning for a vehicle, comprising: 
defining a state space for the vehicle and a plurality of objects, the state space being a 
probability space; 

setting a root node to initial state for the vehicle; 

generating a plurality of paths comprising node-to-node branches from a vehicle start 
location to a goal location, each node being a probability distribution; 

examining each of the branches to determine whether stopping conditions are satisfied; 
generating first ones of the branches using deterministic extension rules comprising: 
a first deterministic rule to add a linear path: and 

a second deterministic rule to extend the linear path by adding a turn such that at 
the end of the turn the vehicle is on a new heading that is closer to obtaining the goal 
position ; 

generating second ones of the branches using random extension rules; 
determining whether first ones of the plurality of branches should terminated; and 
selecting a first one of the plurality of paths that extend to the goal location. 



23. (Original) The method according to claim 22, further including assigning state 
information to the plurality of objects including one or more of position, heading, velocity, 
acceleration, turning radius, acceleration limit, velocity limit, g-force limit, and location 
confidence level. 
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24. (Currently Amended) A system to plan a path to a vehicle, comprising: 
a workstation including 

a processor coupled to a memory containing instructions to enable the steps of: 
defining a state space for the vehicle and a plurality of objects, the state 
space being a probability space; 

setting a root node to initial state for the vehicle; 

generating a plurality of paths comprising node-to-node branches from a 
vehicle start location to a goal location, each node being a probability distribution; 

examining each of the branches to determine whether stopping conditions 
are satisfied; 

generating first ones of the branches using deterministic extension rules 
comprising: 

a first deterministic rule to add a linear path; and 

a second deterministic rule to extend the linear path by adding a turn such 
that at the end of the turn the vehicle is on a new heading that is closer to 
obtaining the goal position ; 

generating second ones of the branches using random extension rules; 

determining whether first ones of the plurality of branches should 
terminated; and 
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selecting a first one of the plurality of paths that extend to the goal 



location. 



25. (Original) The system according to claim 24, further including program instructions 
to provide state information to the plurality of objects including one or more of position, 
heading, velocity, acceleration, turning radius, acceleration limit, velocity limit, g-force limit, 
and location confidence level. 

26. (Original) The system according to claim 24, further including program instructions 
to download the selected path to the vehicle. 

27. (New) The system of claim 24 wherein the first deterministic rule to add a linear path 
comprises a rule to add a linear path such that a heading and speed of the vehicle are constant. 



